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1.  EXECUTIVE  SUMMARY 


The  University  of  Wyoming  has  formed  a  robotics  initiative  consisting  of  three  distinct  parts.  A 
complete,  stand-alone  final  technical  report  is  presented  for  each  phase.  Phase  1  was  managed  by 
Dr.  Cameron  Wright,  Phase  2  by  Dr.  John  O’Brien,  and  Phase  3  by  Dr.  John  Mclnroy.  The 
overall  project  was  coordinated  by  the  Robotics  Initiative  Manager,  Dr.  John  Mclnroy. 

Phase  1,  “Biomimetic  Vision  Sensor,”  AFRL-RX-TY-TR-201 1-0096-01  summarizes  the 
development  of  a  novel  computer  vision  sensor  based  upon  the  biological  vision  system  of  the 
common  housefly,  Musca  domestica.  Several  variations  of  this  sensor  were  designed,  simulated 
extensively,  and  hardware  prototypes  were  constructed  and  tested.  Initial  results  indicate  much 
greater  sensitivity  to  object  motion  than  traditional  sensors,  and  the  promise  of  very  high  speed 
extraction  of  key  image  features.  The  main  contributions  of  this  research  include:  (1) 
characterization  of  the  image  information  content  presented  by  a  biomimetic  vision  sensor,  (2) 
creation  of  algorithms  to  extract  pertinent  image  features  such  as  object  edges  from  the  sensor 
data,  (3)  fabrication  and  characterization  of  sensor  prototypes,  (4)  creation  of  an  automated 
sensor  calibration  subsystem,  (5)  creation  of  a  light  adaptation  subsystem  to  permit  use  of  the 
sensor  in  both  indoor  and  outdoor  real-world  environments. 

Phase  2,  “Lightweight,  Low  Power  Robust  Means  of  Removing  Image  Jitter,”  AFRL-RX- 
TY-TR-201 1-0096-02,  develops  an  optimal  platform  stabilization  mechanism  for  motion 
detection  and  target  tracking  using  recent  advances  in  the  area  of  Parallel  Kinematic  Machines 
(PKMs).  Novel  PKM  architectures  have  been  developed  for  high  performance  disturbance 
rejection  and  target  tracking.  Nonlinear  feedback  control  has  been  successfully  implemented  on 
this  hardware  allowing  for  maximum  feedback  and  stability  despite  the  presence  of  nonlinearities 
in  the  feedback  loop.  Modified  command  feed-forward  has  been  successfully  implemented  on 
these  PKMs  that  provide  high  performance  tracking  despite  significant  non-minimum  phase 
delay.  The  combination  of  these  new  PKMs  and  advanced  control  methods  is  a  substantial  new 
Air  Force  capability  for  future  unmanned  ground  vehicle  applications. 

Phase  3,  “Unification  of  control  and  sensing  for  more  advanced  situational  awareness,” 

AFRL-RX-TY-TR-201 1-0096-03,  develops  a  multi-purpose  planning  scheme  that  effectively 
solves  patrolling  and  constrained  sensor  planning  problems  for  a  large-scale  multi-agent  system. 
This  situation  arises  when  some  mobile-robots  are  performing  a  patrolling  mission,  and,  at  the 
same  time,  gathering  visual  data  from  pre-defmed  objects  in  the  map.  The  proposed  technique 
doesn't  directly  tackle  the  merged  problem  with  the  complicated  cost  function.  Instead,  it 
suggests  a  sequential  scheme  that  considerably  simplifies  the  main  multi-objective  problem,  and 
makes  it  easier  to  make  a  compromise.  The  simulation  confirms  the  effectiveness  of  the 
proposed  multi-objective  multi-agent  planning  scheme  for  different  size  systems. 

This  report  covers  Phase  2,  “Lightweight,  Low  Power  Robust  Means  of  Removing  Image 
Jitter,”  AFRL-RX-TY-TR-201 1-0096-02. 
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2,  INTRODUCTION 


Robot  kinematic  research  has  increasingly  focused  on  parallel  mechanisms,  where  the  end- 
effector  connects  to  the  base  via  multiple  kinematic  chains.  This  trend  is  driven  by  stringent  task 
space  accuracies  required  for  precision  machining,  micro-assembly,  and  accurate  pointing 
applications  that  common  serial  chain  mechanisms  are  ill-equipped  for  due  to  their  intrinsic 
flexibility  and  accuracy  reductions  due  to  cumulative  joint  error.  The  complexity  of  singularity 
analysis  [1-3]  and  limited  workspace  are  some  of  the  more  severe  drawbacks  of  parallel  robots. 

In  contrast  to  serial  chain  manipulators,  singularities  in  parallel  mechanisms  have  different 
manifestations.  This  issue  has  been  studied  in  the  multi-finger  grasping  context  in  [4], [5]  and 
more  recently  for  general  parallel  mechanisms  in  [6], [7].  In  [7],  the  singularities  are  separated 
into  two  broad  classifications:  end-effector  and  actuator  singularities.  The  former  is  comparable 
to  the  serial  arm  case,  where  the  end-effector  loses  a  degree-of-freedom  in  the  Cartesian  task 
space.  The  latter  is  defined  when  a  certain  task  wrench  cannot  be  resisted  by  active  joint  torques 
or,  equivalently,  the  task  frame  can  move  even  when  all  the  active  joints  are  locked.  These  are 
called  the  unstable  configurations  in  [7]  which  correspond  to  unstable  grasps  in  multi-finger 
grasp  literature.  The  existence  of  unstable  singularities  must  be  determined  before  the 
mechanism  is  built. 

Six-  degrees  of  freedom  (DOF)  parallel  mechanisms  commonly  consist  of  six  parallel  chains, 
each  having  one  actuator.  The  Gough-Stewart  [8]  platform  has  six  parallel  prismatic  legs 
connecting  the  end-effector  to  the  base.  Six-legged  mechanisms  tend  to  have  small  workspaces,  a 
characteristic  that  can  be  improved  if  the  number  of  legs  is  reduced.  The  use  of  Gough-Stewart 
Platforms  with  compliant  voice  coil  actuators  for  six-axis  vibration  suppression  applied  to  the 
Space  Interferometry  Mission  is  reported  in  [9].  Vibration  suppression  is  provided  at  low 
frequency  by  active  voice  coil  control  and  at  high  frequency  by  passive  isolation.  This 
technology  is  modified  to  provide  a  fault  tolerant  precision  pointing  functionality  in  addition  to 
six-axis  vibration  isolation  in  [10].  The  voice  coil  actuators  provide  high-bandwidth  positioning, 
and  precision  flexures  are  used  in  place  of  standard  passive  joints  to  provide  linear  motion  to 
very  small  displacements.  The  small  workspace  and  very  high  bandwidth  disturbance  rejection 
these  actuators  provide  is  well  suited  for  space-borne  applications. 

This  paper  summarizes  the  design  and  initial  test  results  of  a  limited-DOF  parallel  mechanism 
with  high-force,  compliant  voice  coil  actuators  for  vibration  suppression.  The  parallel  machine 
architecture  and  its  kinematic  analysis  are  presented.  Dynamic  test  data  for  the  voice  coil 
actuator  is  provided.  The  experimentally  acquired  plant  frequency  responses  are  reported  for  the 
2-axis  pointing  problem.  A  fourth-order  pointing  controller  is  designed,  and  closed  loop 
vibration  suppression  performance  is  presented. 
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3.  METHODS,  ASSUMPTIONS,  AND  PROCEDURE 


A  diagram  of  the  PUS-RR  (prismatic,  universal,  spherical-revolute,  revolute)  mechanism  is 
shown  in  Figure  1.  The  base  and  the  end  effector  are  connected  by  two  legs.  The  leg  connecting 
points  0  and  E  has  the  following  architecture;  an  active  revolute  joint  connected  to  the  base 
followed  by  a  passive  revolute  joint.  The  leg  connecting  points  B  and  E  has  the  following 
architecture:  a  prismatic  actuator,  which  changes  the  distance  between  point  1  and  E  followed  by 
a  passive  universal  joint  at  point  1,  a  passive  spherical  joint  at  point  2  which  is  rigidly  connected 
to  the  end  effector  at  point  E.  A  wrench  applied  at  the  end  effector  is  resisted  by  the 
mechanism’s  structure  and  active  joint  forces.  The  leg  connecting  points  0  and  E  allows  for  yaw 
rotation  of  the  end  effector  only,  and  the  leg  connecting  points  B  and  E  allows  for  pitch  rotation 
on  the  end  effector  only  through  changing  the  length  of  the  prismatic  actuator  between  points  B 
and  1. 

The  University  of  Wyoming  has  constructed  a  prototype  PUS-RR  for  vibration  isolation 
applications.  The  architecture’s  simplicity  allows  for  quick  and  inexpensive  machining  and 
fabrication  work.  The  detailed  hardware  description  follows. 


Figure  1,  PUS-RR  Parallel  Robotic  Architecture 


3.1.  Kinematics  of  the  PUS-RR  Mechanism 

The  position  kinematics  of  the  mechanism  must  be  understood  before  control  synthesis  so  that 
individual  joint  commands  can  be  generated  as  a  function  of  pose  error.  The  velocity  kinematics 
must  also  be  solved  so  that  the  existence  of  singularities  that  cannot  be  compensated  by 
automatic  control  can  be  identified,  and  the  mechanism  architecture  suitably  modified  to 
eliminate  them. 

3.2.  Inverse  Kinematics  of  the  PUS-RR 

The  PUS-RR  kinematics  is  decoupled,  allowing  separate  control  of  x-axis  rotation  (prismatic 
arm)  and  y-axis  rotation  (revolute  arm).  The  inverse  kinematic  solution  for  the  y-axis  rotation  is 
simply  the  revolute  motor  rotation  matching  the  desired  y-axis  angle.  To  find  the  required 
prismatic  arm  position  for  a  desired  end-effector  x-axis  rotation  angle,  the  triangle  made  by  the 
PUS  links  and  variable  side  13  shown  in  Figure  2  is  analyzed.  Remaining  angles  are  found  using 
the  sine  law. 
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Uncontrolled  end-effector  motion  is  possible  in  unstable  configurations,  where  the  passive 
eonstraint  Jaeobian  is  singular  [12],  Careful  kinematic  analysis  is  necessary  to  ensure  the 
workspaee  is  free  of  this  type  of  singularity  before  construetion  of  the  parallel  meehanism. 
Figure  3  shows  a  singular  configuration,  which  is  outside  the  workspace. 


Figure  3,  PUS-RR  Singular  Configuration 


3,3,  Workspace  of  PUS-RR 

In  the  case  of  parallel  mechanisms  with  physical  joint  limits,  the  obtainable  workspace  must  be 
identified  along  with  the  singular  configurations.  Once  the  kinematics  and  singular 
configurations  of  the  PUS-RR  are  understood,  the  physical  joint  limits  must  be  identified  and  the 
dimensions  of  the  prototype  links  can  be  selected  such  that  the  desired  workspaee  is  obtained. 
The  desired  workspaee  for  the  PUS-RR  is  20  deg  in  pitch  and  yaw  rotation  of  the  end  effector. 
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The  physical  joint  limits  for  the  prototype  have  been  identified  as  75  deg  of  rotation  in  the 
universal  joint  with  respect  to  both  the  h_{ul}  and  h_{u2}  axis  at  1  and  17  deg  of  rotation  in  the 
spherical  joint  at  2.  The  lengths  of  1_{1}  and  1_{2}  are  modified  until  the  end  effector  can  be 
moved  through  the  entire  desired  workspace.  The  architecture  of  the  PUS-RR  prototype  is 
selected  as  l_2=2cm,  l_l=5cm  and  with  a  right  angle  spherical  joint  at  point  2.  The  prismatic 
joint  displacement  as  a  function  of  end-effector  position  is  shown  in  Figure  4,  the  universal  joint 
displacement  in  Figure  5  and  the  spherical  joint  in  Figure  6,  respectively.  The  Figures  show  that 
the  obtained  workspace  for  end  effector  is  17  deg  of  yaw  rotation  with  a  displacement  of  1.5  cm 
of  the  prismatic  actuator.  The  end  effector  can  rotate  28  deg  (pitch  rotation)  and  is  limited  by  the 
throw  of  the  spherical  joint  located  at  point  2. 
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Figure  4,  Prismatic  Joint  Displacement 
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Figure  5,  Prismatic  Universal  Joint  Angle 
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3,4,  Actuators  and  Sensor  Description 


The  first  phase  of  experiments  involves  the  development  of  a  2-axis,  closed-loop  vibration 
suppression  control  system  using  the  PUS-RR  parallel  mechanism  using  high-bandwidth,  large 
force  prismatic  actuator  and  a  DC  brushless  high  speed  servo  motor.  This  prototype  parallel 
mechanism  is  shown  in  the  0-configuration  in  Figure  7.  The  following  subsections  detail  the 
actuators,  sensor,  and  single-axis  tests. 


End  Effector  and  Gyro 
Sensor 


Universal  Joint 


Prismatic  Voice  Coil  Actuator 


Rcvolutc  Actuator  Sphere  Joint 

Figure  7,  PUS-RR  Parallel  Robot  Assembly 


The  prismatic  actuator  is  a  voice  coil  connected  mechanically  in  series  with  two  helical  springs 
for  self  centering  when  not  powered.  The  voice  coil  is  capable  of  SOON  of  force  and  the 
maximum  displacement  is  4  cm.  The  actuator  connects  to  the  end  effector  by  a  universal  joint 
and  spherical  joint  (PUS).  On  the  other  side,  the  revolute  motor  is  connected  to  the  end  effector 
through  a  passive  revolute  joint  (RR).  The  revolute  motor  is  a  standard  NEMA  23  motor  by 
Technic.  This  motor  provides  adequate  holding  torque  and  acceleration,  and  has  an  integrated 
closed  loop  controller  commercially  available  that  interfaces  with  the  motor's  encoder.  The 
controller  is  the  SSt-Eclipse,  a  high  bandwidth  digital  vector  servo  drive.  This  drive  features 
controls  for  position,  velocity  and  torque/force  feedback  loops.  The  drive  is  in  torque  mode  for 
these  experiments. 

Two-axis  vibration  suppression  is  the  goal  of  the  first  closed  loop  experiments  using  the  PUS-RR 
parallel  architecture.  Two  Analog  Devices  ADXRS610  300  deg  single-axis  gyroscope  sensors 
are  used  to  measure  the  pitch  and  yaw  angular  velocities  of  the  end  effector.  The  ADXRS610 
300  deg  has  an  operational  bandwidth  of  360  Hz. 
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4.  RESULTS  AND  DISCUSSION 


The  PUS-RR  is  a  two-axis  sensor  pointing  and  vibration  suppression  system.  For  these  initial 
experiments,  vibration  suppression  is  the  only  eontrol  goal.  A  loop-shaping  approaeh  is  used  for 
eontrol  design,  as  it  is  quite  effeetive  at  allowing  the  designer  to  maximize  feedbaek  at  the 
frequeneies  of  interest  while  taking  into  eonsideration  the  limitations  presented  by  plant 
dynamics,  sensor  noise,  sources  of  non-minimum  phase,  etc.  The  decade  of  1-10  Hz  is  targeted 
for  maximum  disturbance  rejection. 


For  aggressive  control  applications  such  as  this  one,  developing  a  plant  model  with  sufficient 
fidelity  is  very  difficult.  Thus,  control  design  is  performed  using  experimentally  obtained 
frequency  response  functions.  To  identify  the  plant  frequency  responses,  it  is  driven  with  band- 
limited  white  noise  and  the  response  as  measured  by  the  gyro  sensors  is  recorded.  Data  is 
acquired  using  an  Agilent  VXI  platform  and  the  plant  frequency  responses  are  derived  using 
Applied  Physics  SignalCalc  6.0  software.  The  2x2  plant  frequency  responses  are  shown  in 
Figure  8. 


Frequency  (Hz) 


Bode  Diagram 


Figure  8,  PUS-RR  Plant  Frequency  Response,  The  left  column  are  the  responses  to  the 
prismatic  actuator,  the  right  are  the  responses  to  the  revolute  actuator. 


The  plant  frequency  response  magnitudes  are  shown  in  Figure  8.  The  plots  on  the  diagonal  are 
the  X  and  y-axis  responses  to  their  respective  actuator  inputs.  The  off-diagonal  plots  are  the 
cross-coupled  responses.  While  the  plant  is  2  x  2,  the  first  generation  design  is  two  independent 
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SISO  controllers  (off-axis  moduli  are  not  excessive).  There  are  several  aspects  of  the  system  that 
limit  the  effective  bandwidth,  and  thus  available  feedbaek.  The  eontrollers  are  implemented 
digitally  with  a  sample  rate  of  5k  Hz.  It  takes  0.2ms  for  the  analog  gyro  signals  to  be  digitized, 
proeessed,  and  then  eonverted  baek  to  analog.  This  time  delay  results  in  non-minimum  phase  that 
is  linearly  proportional  to  frequency.  The  gyro  signals  are  biased  by  voltage  around  2.5V  that  can 
drift  with  temperature  fluetuations.  As  sueh,  band  pass  controller  designs  were  adopted.  Design 
of  both  eontrollers  is  discussed  in  the  following  two  subseetions. 

The  plant  frequeney  response  for  the  x-axis,  P_x,  can  be  seen  in  the  top  left  plot  in  Figure  8.  The 
slope  of  the  plant  modulus  is  approximately  20dB/dee  from  0  Hz  to  2  Hz,  OdB/dee  from  2  Hz  to 
65  Hz,  and  -40dB/dec  afterwards.  The  helical  springs  are  responsible  for  the  flexible  modes  seen 
around  90  Hz  and  150  Hz.  The  controller,  C_x,  was  earefully  designed  to  produce  the  loop 
transmission  T_x  and  sensitivity  S_x  shapes  seen  in  Figure  9.  The  eontroller  offers  a  maximum 
of  28  dB  of  disturbance  rejection  over  the  target  decade  of  1-10  Hz.  The  x-axis  eontroller  is  an 
eighth  order  compensator  as  seen  in  Figure  9. 

An  eighth  order  eontroller  is  required  to  produee  the  desired  T_x  and  S_x.  A  zero  at  2  Hz  and 
eonjugate  zero  pair  at  65  Hz  effeetively  straightens  the  eorners  seen  in  the  original  plant.  An 
origin  zero  together  with  conjugate  pole  pairs  at  1  Hz  and  10  Hz  ereate  the  general  band  pass 
shape  of  T_x.  A  first  order  lead  filter  around  0.1  Hz  ensures  that  there  is  around  30  degrees  of 
phase  margin  at  the  first  crossover.  Likewise,  a  Bode  step  [15]  from  100  Hz  to  400  Hz  is 
required  to  aehieve  a  similar  phase  margin  around  the  seeond  erossover  at  50  Hz.  This  step  is 
created  by  a  eonjugate  zero  pair  at  90  Hz  with  a  single  pole  and  conjugate  pole  pair  at  200  Hz. 

The  plant  frequeney  response  for  the  y-axis,  P_y,  is  shown  in  the  bottom  right  plot  in  Figure  8. 
The  slope  of  the  plant  modulus  is  approximately  20dB/dee  from  0  Hz  to  10  Hz  and  -20dB/deo 
afterwards.  Flexible  body  dynamics  associated  with  the  sensor  eables  are  more  pronounced  for 
the  y  axis  and  are  responsible  for  the  mode  around  630  Hz.  There  is  also  only  slight  coupling  to 
one  of  the  helieal  spring  resonanees  around  150  Hz.  The  laek  of  flexible  modes  made  design  of 
the  y  axis  eontroller  simpler  than  that  of  the  x  axis  controller,  and  also  allowed  for  nearly  6dB 
more  negative  feedback  in  the  frequeneies  of  interest. 

Design  of  the  y  axis  controller  proceeded  similar  to  that  of  C_x.  A  zero  was  placed  at  the  origin 
for  a  band  pass  loop  transmission,  and  conjugate  pole  pairs  at  1  Hz  and  10  Hz  define  the  eorners 
of  the  functional  bandwidth.  A  zero  at  16  and  zero  pair  at  35  Hz  flattens  the  loop  gain  resulting 
in  a  Bode  step  from  approximately  200  Hz  to  630  Hz.  The  phase  at  630  Hz  is  nearly  -75  degrees 
so  that  this  mode  could  cross  the  OdB  line  without  threatening  elosed  loop  stability.  If  this  mode 
had  been  gain  stabilized  as  opposed  to  phase  stabilized,  then  the  second  crossover  frequency 
would  be  lower,  as  well  as  the  amount  of  available  feedback  between  1  Hz  and  10  Hz.  The 
resulting  loop  transmission  T_y  and  sensitivity  S_y  functions  can  be  seen  in  Figure  11.  The 
controller  provides  a  maximum  of  34  dB  of  disturbance  rejeetion  over  the  target  deeade  of  1-10 
Hz.  The  y-axis  controller  is  a  forth  order  eompensator  and  is  seen  in  Figure  10. 
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Bode  Diagram 
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Figure  9,  X-axis  Plant,  Loop  Transmission  with  Vibration  Suppression  Compensator  and 

Sensitivity  Frequency  Response  Functions 


Bode  Diagram 


Figure  10,  X-axis  Vibration  Suppression  Compensator  Frequency  Response  Function 
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Bode  Diagram 


-2-101234 
10  10  10  10  10  10  10 

Frequency  (Hz) 

Figure  11,  Y-axis  Plant,  Loop  Transmission  with  Vibration  Suppression  Compensator  and 

Sensitivity  Frequency  Response  Functions 

The  controllers  are  implemented  on  a  National  Instruments  PXI  8106  Controller  with  a  loop  rate 
of  5  K  Hz.  The  controllers  were  both  discretized  using  the  Tustin  transformation.  However, 
calculating  the  HR  (Infinite  Impulse  Response)  coefficients  from  the  zero,  pole,  gain  model  of 
the  eighth-order  x-axis  controller  posed  a  problem  due  to  the  high  compensator  order  and  the 
dynamic  range  of  pole  frequencies.  This  problem  is  solved  by  implementing  the  x  axis  controller 
using  two  cascaded  HR  filters;  one  third  order  filter  containing  the  lower  frequency  poles  and 
zeros  and  a  fifth-order  filter  containing  the  remaining  poles  and  zeros. 

The  mechanism  will  eventually  be  mounted  on  a  multi-axis  shake  table  for  base  disturbance 
input.  The  facility  currently  does  not  have  this  hardware,  so  closed  loop  vibration  suppression 
experiments  use  the  active  legs  of  the  two  leg  mechanism  for  disturbance  injection  to  the  end- 
effector.  A  random  signal  is  added  to  the  control  signal  of  each  actuator. 

The  time  domain  response  of  the  open  and  closed  loop  system  can  be  seen  in  Figure  12.  A 
disturbance  signal  consisting  of  white  noise  band-limited  to  10  Hz  signal  is  used  to  drive  each 
actuator  in  open  and  closed  loops.  White  noise  band-limited  to  10  Hz  is  selected  since  it  is 
assumed  that  the  disturbance  environment  would  fall  below  this  frequency.  The  closed-loop 
system  provides  more  than  30  dB  of  disturbance  rejection  at  low  frequency. 


11 

Distribution  A.  Approved  for  public  release;  distribution  unlimited.  88ABW-2012-2229,  13  April  2012 


X  Axis 


Figure  12,  Time  Domain  System  Response  to  White  Noise  Band — Limited  to  10  Hz  in  Open 

and  Closed  Loop 


4,1,  Closed  Loop  Control  (Phase  1:  Nyquist-Stahle  Control  with  Nonlinear  Dynamic 
Compensation) 

Nonlinear  control  increases  the  available  feedback  for  a  given  bandwidth  restriction.  The 
approach  provides  substantial  roll  reduction  improvement  compared  to  linear  controllers.  A 
Nyquist-stable  pointing  control  system  with  nonlinear  dynamic  compensation  applied  to  a 
limited  DOF  PKM  is  described  in  this  paper.  Despite  a  0  dB  crossover  restriction  less  than  100 
Hz,  the  controller  provides  nearly  40  dB  of  feedback  over  a  10  Hz  functional  bandwidth  and 
satisfies  the  conditions  of  absolute  stability  in  actuator  saturation. 

During  these  experiments,  it  became  apparent  that  friction  forces  heavily  influence  the  system 
dynamics  for  small  displacements  and  velocities.  In  order  to  better  observe  what  was  happening, 
another  sensor  was  added  to  the  robot  to  directly  measure  the  position  of  the  end  effector.  This 
was  accomplished  by  attaching  a  mirrored  surface  to  the  end  effector  so  that  a  stationary  laser 
beam  would  be  reflected  onto  a  photodiode  position  sensing  detector  (PSD).  This  paper 
documents  the  control  experiments  that  were  performed  using  this  new  sensor. 

The  plant  is  a  PUS-RR  parallel  robot  shown  in  Figure  13.  One  kinematic  path  consists  of  an 
active  prismatic  actuator,  universal  joint  and  sphere  joint  (PUS),  while  the  other  is  an  active 
revolute  joint  in  series  with  a  pin  joint  (RR). 
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Figure  13,  PUS-RR  Parallel  Robot  with  a  Laser  Sensor 


The  prismatic  actuator  is  powered  by  a  linear  voice  coil  manufactured  by  BEI  Kimco  Magnetics 
Division,  model  number  LA28-43-000A.  It  is  capable  of  around  300  N  of  force  and  3  cm  of 
displacement.  The  coil  is  mechanically  in  series  with  helical  springs  that  provide  a  restoring 
force  to  keep  the  end  effector  centered  when  unpowered.  The  coil  is  driven  by  an  AE  Techron 
EV608  Linear  Power  Amplifier  operating  in  a  voltage  controlled  voltage  source  mode  with  a 
gain  of  30  Y/V.  The  revolute  actuator  is  a  standard  NEMA  23  sized  electric  motor  by  Techie 
driven  by  an  SSt-Eclipse  digital  controller  running  in  torque  control  mode.  This  DOE  is  not  used 
for  the  control  experiments  described  in  this  paper. 

Attached  to  the  end-effector  are  two  microelectromechanical  system  (MEMS)  gyros  used  to 
measure  the  angular  rate  about  the  two  DOFs.  These  Analog  Devices  ADXRS610  300  deg  single 
axis  gyroscope  sensors  have  an  operational  bandwidth  of  360  Hz.  They  work  by  measuring  the 
deflection  experienced  by  a  proof  mass  resonating  at  14  k  Hz  caused  by  the  Coriolis  effect.  This 
deflection  measurement  is  amplified  and  demodulated  to  provide  a  voltage  output  proportional  to 
the  angular  rate.  The  quiescent  noise  power  spectrum  of  the  gyro,  with  a  peak  at  14  k  Hz,  can  be 
seen  in  Figure  14.  A  time  delay  of  around  0.75  ms  1/(1. 4  k  Hz)  is  also  observed,  and  it  is 
suspected  that  this  is  introduced  by  the  demodulation.  Such  non-minimum  phase  delay  limits  the 
attainable  bandwidth,  and  thus  is  not  used  for  closed  loop  experimentation. 
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Sensor  Noise  Power  Spectrum 


Figure  14,  Quiescent  Sensor  Noise  Power  Spectrum  Densities 


A  Helium  Neon  (HeNe)  laser  is  used  in  conjunetion  with  an  ON-TRAK  Photonies  OT-324 
Position  Sensitive  Deteetor  (PSD)  to  measure  the  end  effeetor  position.  The  stationary  HeNe 
laser  emits  a  632.8  nm  beam  that  is  directed  by  an  adjustable  steering  mirror  towards  the  end 
effector.  A  mirror  attached  to  the  end  effector  deflects  the  beam  onto  the  bare  duolateral 
photodiode  sensor  of  the  PSD.  The  PSD  sensing  amplifier  reports  the  position  of  the  laser  beam 
on  the  two  dimensional  sensor  as  two  analog  voltages  within  10  V.  Figure  14  shows  the 
quiescent  noise  power  spectrum  of  the  position  sensor  along  one  axis.  There  are  peaks  in  the 
position  sensors  spectra  at  120  Hz,  240  Hz,  and  360  Hz.  These  harmonics  are  likely  caused  by  a 
120  Hz  voltage  ripple  on  the  high  voltage  DC  line  powering  the  laser  that  results  from  rectifying 
the  60  Hz  AC  power.  The  higher  operational  bandwidth  of  nearly  15  k  Hz  and  lower  noise 
characteristics  make  the  PSD  better  suited  than  the  gyro  for  the  control  experiments  discussed  in 
this  paper. 

The  system  is  stimulated  by  driving  the  prismatic  actuator  with  band-limited  Gaussian  noise  for 
the  purpose  of  system  identification.  The  stimulus  and  PSD  signals  are  digitized  and  recorded 
using  an  Agilent  VXI  system.  The  data  capture  and  processing  is  performed  using  the  SignalCalc 
6.2  software  suite  from  DataPhysics.  Stimuli  of  varying  amplitudes  and  bandwidth  are  applied 
and  the  corresponding  coherence  and  plant  transfer  functions  are  calculated.  A  nominal  pole- 
zero-gain  (PZK)  model  of  the  plant  is  developed  by  the  manual  placement  of  poles  and  zeros  to 
sufficiently  match  those  transfer  functions  with  the  highest  coherence.  This  15th  order  nominal 
model  P(s)  is  plotted  along  with  the  experimentally  acquired  data  in  Figure  15. 
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Bode  Diagram 
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Figure  15,  PUS-RR  Plant  Frequency  Response 


The  plant  transfer  function  is  low  pass  as  expected.  The  plant  modulus  is  relatively  flat  with  a 
value  around  48  dB  from  0  Hz  to  around  4  Hz,  at  which  point  it  begins  to  roll  off  at 
approximately  6  dB/oct.  At  80  Hz  the  slope  transitions  to  nearly  18  dB/oct  as  there  are  two 
conjugate  pole  pairs  and  one  very  lightly  damped  conjugate  zero  pair  around  this  frequency. 
There  are  interlaced  pole  then  zero  pairs  around  440  Hz  and  840  Hz.  There  are  consecutive  pole 
pairs  at  1  k  Hz  and  1.3  k  Hz,  whose  addition  total  phase  contribution  of  360  deg  places  a  hard 
upper  limit  on  control  bandwidth  and  thus  the  amount  of  available  feedback.  The  phase 
contributions  of  the  well  damped  poles  and  lightly  damped  poles  around  80  Hz  likewise  limit 
control  bandwidth  as  described  later. 

An  absolutely  stable  fixed  gain  (ASFG)  controller  is  designed  to  serve  as  a  baseline  for 
comparison  to  the  nonlinear  controller  described  later.  The  design  goal  is  to  maximize  vibration 
suppression  at  frequencies  below  10  Hz  while  remaining  absolutely  stable.  This  is  accomplished 
by  carefully  shaping  the  compensator  to  obtain  the  return  ratio  seen  in  Figure  16.  Similar  to  the 
development  of  the  nominal  plant  model,  the  PZK  model  is  designed  by  manually  placing  poles 
and  zeros. 
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Bode  Diagram 


Nyquist  Diagram 
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Open-Loop  Phase  (deg) 

Figure  16,  AFSG  Controller  Design 


16 

Distribution  A.  Approved  for  public  release;  distribution  unlimited.  88ABW-2012-2229,  13  April  2012 


A  zero  at  4  Hz  and  a  conjugate  pair  of  zeros  at  80  Hz  compensate  for  the  corners  found  in  the 
original  plant.  A  pair  of  conjugate  poles  placed  at  1 1  Hz  define  the  comer  of  the  functional 
bandwidth  around  10  Hz.  A  pair  of  zeros  at  100  Hz  together  with  pairs  of  poles  at  160  Hz  and 
220  Hz  define  the  Bode  step.  A  lead  filter  with  a  zero  at  60  Hz  and  pole  at  100  Hz,  together  with 
the  Bode  step,  provide  sufficient  phase  advance  around  the  crossover  point.  Thus  a  gain  margin 
of  at  least  10  dB  and  a  phase  margin  of  nearly  50  deg  is  maintained.  This  may  seem  excessive, 
but  it  allows  us  to  demonstrate  absolute  stability  (AS). 

A  major  factor  limiting  bandwidth  is  the  lightly  damped  zeros  and  heavily  damped  poles  around 
80  Hz.  The  phase  lag  of  the  poles  is  more  pronounced  than  the  phase  lead  of  the  zeros  at 
frequencies  below  80  Hz.  Thus  the  phase  sharply  drops  to  nearly  180  deg  around  80  Hz.  There  is 
also  uncertainty  in  the  exact  frequency  and  Q  factor  of  this  mode,  as  it  varied  between  different 
system  identification  experiments.  Thus  the  mode  is  gain  stabilized  in  order  to  retain  adequate 
phase  margins.  The  return  ratio  crosses  0  dB  around  33  Hz  and  the  resulting  7th  order  controller 
provides  nearly  18  dB  of  negative  feedback  below  10  Hz. 

4,2.  Nyquist  Stable  Controller  Design 

A  high  performance  Nyquist  stable  (NS)  controller  C_{NS}(s)  is  also  designed  with  the  goal  of 
maximizing  disturbance  rejection  at  frequencies  below  10  Hz. 

This  controller  need  only  satisfy  the  Nyquist  stability  criterion,  and  not  the  more  restrictive 
conditions  for  absolute  stability.  Since  the  plant  is  open  loop  stable,  the  Nyquist  plot  of  the  return 
ratio  T_{NS}(s)  must  not  encircle  the  -1  critical  point.  Satisfying  the  Nyquist  stability  criterion 
ensures  the  closed  loop  stability  of  the  system  without  saturation. 

A  high  performance  Nyquist  stable  (NS)  controller  C_{NS}(s)  is  also  designed  with  the  goal  of 
maximizing  disturbance  rejection  at  frequencies  below  10  Hz.  By  definition,  the  return  ratio  of  a 
Nyquist  stable  system  has  a  modulus  greater  than  unity  and  phase  less  than  180  degrees  over 
some  interval  of  frequencies.  Furthermore,  since  the  plant  is  open  loop  stable,  the  Nyquist  plot  of 
the  return  ratio  T_{NS}(s)  must  not  encircle  the  -1  critical  point.  As  opposed  to  the  ASFG, 
however,  the  NS  controller  by  itself  is  not  required  to  be  AS. 

C_{NS}  is  designed  by  carefully  shaping  the  return  ratio  by  direct  placement  of  poles  and  zeros. 
A  zero  at  4  Hz  compensates  for  the  bend  in  the  original  plant.  Conjugate  pole  pairs  were  placed 
at  6.75  Hz  and  10  Hz  to  fix  the  functional  bandwidth  at  10  Hz.  The  pole  pair  at  10  Hz  and  a  zero 
pair  at  15  Hz  were  lightly  damped  in  order  to  provide  the  sharp  transitions  seen  in  the  slope  of 
the  return  ratio  at  10  Hz  and  15  Hz.  It  is  this  steep  slope  and  accompanying  phase  lag  that  allows 
us  to  attain  nearly  20  dB  more  negative  feedback  than  with  the  ASFG  controller.  A  pair  of  zeros 
at  60  Hz  and  a  pair  of  poles  at  200  Hz  flatten  the  response  to  produce  a  Bode  step.  A  two  octave 
wide  lead  filter  centered  at  100  Hz  further  flattens  the  response  and  adds  phase  lead.  The  loop  is 
shaped  such  that  the  positive  feedback  never  exceeds  6  dB.  The  loop  transmission  function  is 
shown  in  Figure  17. 

The  resulting  7th  order  compensator  provides  nearly  38  dB  of  disturbance  rejection  below  10  Hz. 
This  is  an  order  of  magnitude  greater  than  the  ASFG  controller.  The  0  dB  crossover  frequency  is 
also  slightly  higher  at  44.5  Hz.  The  return  ratio  satisfies  the  Nyquist  stability  criterion  and  the 
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system  without  saturation  is  stable  in  closed  loop.  However,  no  physically  realizable  system 
behaves  linearly  under  all  conditions.  The  saturation  of  large  signals  is  inevitable  considering  the 
finite  nature  of  real  world  systems. 


Bode  Diagram 


Nyquist  Diagram  for  NS  Control  Design 


Real  Axis 


Nichols  Chart 


Open-Loop  Phase  (deg) 

Figure  17,  Nyquist-stable  System 
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4.2.1.  Effects  of  Saturation 

The  plant  possesses  several  saturation  meehanisms:  the  eontroller  analog  output  voltage  is 
limited  to  10  V,  the  maximum  power  output  of  the  Teehron  amplifier  is  only  a  few  hundred 
watts,  the  stroke  of  the  prismatie  aetuator  is  physieally  limited,  and  the  laser  beam  ean  only  be 
defleeted  a  few  degrees  before  it  misses  the  target  PSD  sensor.  To  investigate  the  effeets  of 
saturation  on  the  elosed  loop  system  without  driving  the  hardware  to  its  physical  operating 
limits,  an  additional  saturation  with  an  adjustable  threshold  is  added  to  the  controller  output.  The 
values  of  t_{sat}  used  during  closed  loop  experimentation  are  sufficiently  low  so  that  this  link 
will  saturate  before  any  of  the  other  sources  of  saturation  mentioned  above. 

Describing  functions  (DF)  and  harmonic  analysis  can  be  useful  for  approximating  the  behavior 
of  a  nonlinear  link  in  a  linear  feedback  system.  Consider  a  sinusoid  of  amplitude  E  fed  into  a 
saturation  block.  For  a  small  amplitude  sinusoid,  E  <  t_{sat},  the  saturation  link  is  equivalent  to 
a  unity  gain.  For  a  large  amplitude  sinusoid,  E  >  t_{sat},  the  output  is  a  waveform  of  reduced 
amplitude  but  of  the  same  frequency  and  phase  of  the  input.  Thus  a  saturation  link  can 
effectively  reduce  the  loop  gain  for  large  signals. 

Consider  the  Nichols  plots  for  the  ASFG  and  NS  controllers.  One  can  see  that  a  broadband 
reduction  of  the  return  ratio  moduli  would  result  in  the  plots  shifting  down  along  the  amplitude 
axis.  Since  |T_{NS}|>0  dB  at  some  frequencies  where  arg(T_{NS})<-180  deg  reducing  the  gain 
will  eventually  result  in  an  encirclement  of  the  critical  point,  and  the  Nyquist  criterion  would  no 
longer  be  satisfied.  This  is  not  the  case  for  ASFG  controller.  The  greater  disturbance  rejection 
performance  of  the  NS  controller  thus  comes  at  the  expense  of  potential  stability  issues.  This  is 
the  motivation  for  development  of  the  nonlinear  dynamic  compensation  (NDC). 

Consider  the  Nichols  plots  for  the  ASFG  and  NS.  A  broadband  reduction  of  the  return  ratio 
moduli  would  result  in  the  plots  shifting  down  along  the  amplitude  axis.  Since  |T_{NS}|>0  dB  at 
some  frequencies  where  arg(T_{NS})<-180  deg,  reducing  the  gain  will  eventually  result  in  an 
encirclement  of  the  critical  point  and  the  Nyquist  criterion  would  no  longer  be  satisfied.  This  is 
not  the  case  for  the  ASFG  controller. 

4.2.2,  Absolute  Stability  and  tbe  Popov  Criterion 

A  linear  time  invariant  (FTI)  system  in  feedback  with  a  nonlinearity  n(e)  is  said  to  be  absolutely 
stable  (AS)  if  it  is  asymptotically  globally  stable  for  any  n(e)  satisfying  the  sector  condition. 

All  of  the  poles  of  T_ {ASFG}  have  negative  real  parts  and  Figure  18  clearly  shows  the  modified 
Nyquist  plot  for  T_{ASFG}  lying  to  the  right  of  a  Popov  line  with  slope  q^{-l}  =  375.  Thus  the 
Popov  criterion  is  satisfied  and  the  ASFG  control  system  truly  is  absolutely  stable.  T_{NS}  is 
also  open  loop  stable,  but  by  the  definition  of  Nyquist  stable  there  exists  an  w_0  such  that 
arg(T_{NS}(j  omega_0))  =  -180  deg  and  |T_{NS}(j  omega_0)|  >  1.  Therefore  Re[ 
(l+qjomega_0)  T_{NS}(jomega_0)  ]  =  -|T_{NS}(jomega_0)|  <  -1  and  the  NS  control  system 
cannot  satisfy  the  Popov  criterion. 


19 

Distribution  A.  Approved  for  public  release;  distribution  unlimited.  88ABW-2012-2229,  13  April  2012 


Modified  Nyquist  Diagram 


Real  Axis 


Modified  Nyquist  Diagram 


Real  Axis 

Figure  18,  Modified  Nyquist  Plots  for  Absolute  Stability  Analysis 


4,2,3,  Nonlinear  Dynamic  Compensator 

An  adaptation  of  the  control  scheme  is  shown  in  Figure  19.  The  additional  feedback  path  is  the 
nonlinear  dynamic  compensator  (NDC).  For  small  signals  the  output  of  the  summing  junction  in 
the  NDC  path  is  zero.  Thus,  the  effective  return  ratio  for  small  signals  is  simply  T_{NS}.  For 
large  signals,  however,  this  difference  is  nonzero  and  the  NDC  feedback  path  is  active.  Therefore 
the  NDC  is  able  to  reshape  the  effective  return  ratio  of  the  controller  for  large  signals. 
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Figure  19.  Equivalent  Systems  for  the  NS  with  NDC  Controller 


The  purpose  of  the  NDC  is  to  obtain  an  AS  equivalent  return  ratio  T_{EQ}.  Thus  T_{ASFG} 
ean  serve  as  a  target  for  T_{EQ}.  Eor  a  given  desired  equivalent  return  ratio  T_{EQ}^D  = 
T_{ASEG}  and  T_{NS},  a  target  NDC  design  T_{NDC}^D  is  ((T_{NS}-  T_{EQ}^D)/(1+ 
T_{EQ}^D))=((  T_{NS}-  T_{ASEG})/(1+  T_{ASEG})). 

The  order  of  the  resulting  T_{NDC}^D  is  quite  high,  and  its  implementation  eould  pose  serious 
ehallenges.  Therefore,  a  lower  order  NDC  is  sought.  A  redueed  order  NDC  is  thus  developed  by 
the  manual  plaeement  of  poles  and  zeros.  An  iterative  approach  is  indicated  here  as  the  resulting 
equivalent  return  ratio  T_{EQ}  will  differ  from  T_{EQ}^D,  and  AS  will  have  to  be  verified.  The 
resulting  9th  order  T_{NDC}  and  40th  order  T_{NDC}^D  are  plotted  in  Figure  20. 
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Bode  Diagram 


Frequency 

Figure  20,  NDC  Design 


Well  damped  pole  pairs  at  6.75  Hz  and  250  Hz  in  combination  with  lightly  damped  poles  at  10 
Hz  and  400  Hz  capture  the  sharp  bends  in  T_{NDC}^D  seen  around  these  frequencies.  Likewise, 
well  damped  zeros  at  12.3  Hz  and  lightly  damped  zeros  at  20  Hz  produce  the  remaining  comer. 

A  pole  around  35  Hz  together  with  a  zero  around  282  Hz  helps  match  the  modulus  slope  between 
these  frequencies. 

The  equivalent  return  ratio  is  T_{EQ}  =  ((T_{NS}  -  T_{NDC})(1+  T_{NDC})).  The  modified 
Nyquist  plot  of  T_{EQ}  is  shown  in  Eigure  18  and  lies  entirely  to  the  right  of  the  Popov  line 
with  slope  q^{-l}=375.  T_{EQ}  is  Hurwitz,  therefore  the  combined  NS  with  NDC  controller  is 
AS. 

4,2,4,  Closed  Loop  Experiments 

All  control  design  work  is  performed  using  MATLAB  and  the  Control  Systems  Toolbox.  The 
continuous  time  PZK  models  of  the  final  control  designs  are  discretized  using  Tustin's  method. 
The  poles  and  zeros  were  grouped  to  form  a  cascade  of  second  order  systems.  This  approach  of 
PZK  design  lessens  the  effects  of  finite  precision  arithmetic  and  round  off  errors. 

Custom  software  developed  with  National  Tnstmments  LabWindows/  CVI  executes  on  a 
National  Instmments  PXI  8106  Real  Time  Controller.  The  program  implements  the  7th  order 
C_{ASPG},  7th  order  C_{NS},  and  9th  order  T_{NDC}  at  a  loop  rate  of  10  k  Hz.  It  should  be 
noted  the  digitizing,  processing,  and  outputting  of  signals  must  take  no  longer  than  1/10  k  Hz 
=0.1  ms.  This  worst  case  time  delay  is  included  in  the  controller  models  during  the  design  phase. 
However,  a  0.1  ms  time  delay  only  contributes  3.6  deg  of  non-minimum  phase  at  100  Hz  and  36 
deg  at  1  k  Hz.  Thus  it  is  not  a  major  limiting  factor  in  maximizing  the  crossover  frequency. 
Companion  software  running  on  a  Windows  XP  machine  allows  for  loops  to  be  open  and  closed, 
disturbances  enabled  or  disabled,  and  saturation  thresholds  and  proportional  gains  to  be  adjusted 
in  real  time. 
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4.2.4.I.  Disturbance  Environment 

While  it  would  be  desirable  to  mount  the  meehanism  on  a  shake  table,  the  faeility  does  not 
eurrently  have  this  hardware.  The  robot  is  rigidly  mounted  to  an  air  suspended  optics  table,  so 
the  prismatic  actuator  itself  is  used  for  disturbance  injection.  A  disturbance  signal  is  simply 
added  to  the  output  of  the  controller  before  it  is  fed  to  the  Techron  amplifier  input.  A  plot  of  the 
disturbance  generating  signal  with  its  power  spectral  density  (PSD)  is  shown  in  Figure  21.  The 
signal  is  generated  by  passing  white  noise  through  a  10  Hz  first-order,  low-pass  filter  and 
summing  it  with  a  5  Hz  sinusoidal  tone. 

The  performance  of  both  the  ASFG  and  the  NS  with  NDC  controllers  are  verified  in  closed  loop 
tests.  The  disturbance  source  described  above  is  used  in  all  cases,  but  t_{sat}  is  varied.  A 
threshold  of  150  mV  is  sufficiently  high  to  ensure  that  control  effort  saturation  seldom  occurs.  In 
this  small  signal  regime,  the  NDC  is  inactive  and  the  effective  return  ratio  of  the  NS  with  NDC 
controller  is  T_{NS}.  This  is  evidenced  by  nearly  40  dB  of  disturbance  rejection  below  10  Hz  as 
seen  in  the  power  spectral  density  plot  in  Figure  22.  A  saturation  threshold  of  50  mV  is 
sufficiently  low  to  saturate  the  control  effort  some  of  the  time.  In  this  large  signal  scenario,  the 
NDC  link  is  active  and  reduces  the  effective  return  ratio  to  a  less  aggressive  loop  shape  as  shown 
in  Figure  23.  Comparing  the  performance  of  the  ASFG  controller  between  the  small  and  large 
signal  cases,  we  see  that  its  effectiveness  was  also  reduced  in  the  saturated  case. 

The  first  half  of  Figure  23  demonstrates  the  unstable  nature  of  the  NS  controller  without  the 
NDC.  With  t_{sat}  =  100  mV,  the  NS  controller  without  NDC  is  able  to  operate  stably  for  some 
time  until  the  control  effort  saturates.  After  this  initial  saturation,  the  control  output  oscillates 
wildly,  ensuring  further  saturation. 

Two  different  control  strategies  are  applied  to  the  prismatic  axis  of  a  limited  DOF  PKM,  and 
their  performance  in  closed  loop  is  demonstrated.  The  goal  is  to  maximize  the  amount  of 
negative  feedback  for  disturbance  rejection  in  the  frequency  interval  from  0  Hz  to  10  Hz.  The 
linear  controller  C_{ASFG}  is  shown  to  be  absolutely  stable  and  provides  nearly  18  dB  of 
feedback  over  the  frequencies  of  interest.  The  high  performance  nonlinear  controller  consisting 
of  a  Nyquist  stable  controller  C_{NS}  with  nonlinear  dynamic  compensation  T_{NDC}  is  also 
shown  to  be  absolutely  stable.  In  the  small  signal  case  the  NDC  with  NS  is  able  to  provide  38  dB 
disturbance  rejection  below  10  Hz.  This  is  an  order  of  magnitude  better  than  the  ASFG 
controller.  In  the  large  signal  case,  i.e.  when  the  control  signal  saturates,  the  nonlinear  controller 
is  able  to  perform  at  least  as  well  as  the  fixed  gain  controller. 
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Amplitude  (V) 


Disturbance  Generating  Signal 


Time  (s) 


Disturbance  Power  Spectrum  Density 


Figure  21,  Disturbance  Generating  Signal  Used  in  Closed  Loop  Tests 
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Saturation  Threshold  150mV 


Freouencv  tHzt 


Saturation  Threshold  50mV 


Freouencv  tHzt 

Figure  22,  Open  vs.  Closed  Loop  Power  Spectrum  Densities 
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Bode  Diagram 


Open-Loop  Phase  (deg) 

Figure  23,  NS  vs,  NS  with  NDC  vs,  ASFG  Controller  Design  Comparison 


Bode  Diagram 


Figure  24,  Plant  Response  to  White  Noise  Stimulus  of  Differing  Amplitude 
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4,3,  Closed  Loop  Control  (Phase  2:  Camera  Tracking  Using  Modified  Command  Feed¬ 
forward) 

Traditionally,  the  command  feed-forward  approach  is  not  used  for  systems  that  are  non- 
minimum-phase,  as  their  inverses  are  either  unstable  or  non-causal.  To  overcome  this  limitation, 
while  gaining  performance,  the  nominal  plant  model  developed  from  the  fitting  of  the  magnitude 
frequency  response  data  was  used  as  the  starting  point  for  the  design  of  the  command  feed¬ 
forward  system.  Investigation  of  the  block  diagram  and  associated  closed  loop  transfer  function 
led  to  further  ideas  for  modifying  the  command  feed-forward  control.  The  block  diagram  of  the 
command  feed- forward  control  system  is  shown  in  Figure  25. 


Figure  25,  Command  Feed-forward 


U2 


The  goal  of  command  feed-forward  is  to  push  the  tracking  performance  beyond  the  bandwidth  of 
the  feedback  controller  alone.  The  goal  for  tracking  systems  is  to  maintain  unity  gain,  from  input 
to  output,  across  the  desired  frequency  range.  With  command  feed-forward  control  architectures, 
there  are  two  cases  where  this  unity  gain  is  seen.  First  is  in  the  case  of  large  feedback  and  second 
is  when  the  plant  transfer  function  does  not  deviate  much  from  the  nominal  plant  model  in  the 
feed-forward  path. 

The  mechanism  of  a  PRRR-RR  parallel  robot  is  shown  in  Figure  26.  This  mechanism  utilizes 
two  actuators,  primarily  off  the  shelf  passive  joints,  and  a  commercial  off-the-shelf  (COTS) 
camera  for  the  purposes  of  tracking  a  given  reference  signal.  This  mechanism  is  extremely 
simple  in  the  two  independent  axes  of  movement,  leading  to  the  two  end-effector  degrees-of- 
freedom  (DOFs)  being  decoupled. 


Joints 


Camera 


Bearing 


Prismatic 


Revolute 

Actuator 


Actuator 


Figure  26,  RR-PRR  Parallel  Mechanism  with  a  Camera 
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The  mechanism  consists  of  two  closed  kinematic  paths.  One  kinematic  path  consists  of  a 
prismatic  actuator,  a  passive  ball  bearing  revolute  joint  and  two  passive  revolute  pin  joints 
(PRRR).  The  other  kinematic  path  is  a  revolute  actuator  in  series  with  a  single  passive  pin  joint 
(RR).  This  architecture  has  two  decoupled  DOFs  for  the  camera  movement.  These  are  designated 
the  X-Axis  in  the  prismatic  direction  of  movement  and  the  Y-Axis  in  the  revolute  direction  of 
movement.  Analysis  using  a2  x  2  multiple-input,  multiple-output  MIMO  Nyquist  array  and 
Gershgorin  discs  shows  diagonal  dominance  of  the  plant,  verifying  that  the  two  axes  are 
decoupled,  and  stability  of  the  2x2  multivariable  system. 

4,3,1,  Camera  System 

The  primary  sensor  used  in  this  experiment  is  a  COTS  camera.  Target  tracking  software  that 
utilizes  the  camera  output  is  hosted  on  a  standard  x86  based  PC,  and  target  tracking  results  are 
conveyed  to  the  stabilization  robot's  control  system  via  analog  voltages  produced  by  a  data 
acquisition  card.  Very  simple  image  processing  software  capable  of  tracking  a  bright  dot 
produced  by  a  laser  or  oscilloscope  has  been  implemented  to  test  the  camera's  viability  as  a  real¬ 
time  sensor.  Figure  27  shows  the  block  diagram  of  the  sensor  system. 


Optical  Path 
Analog  Voltage 
IEE13g4b  Bus 
PCI  Bus 


Figure  27,  Sensor  Sub-system 


The  FL3-FW-03S1C  (Flea3)  is  a  compact  (29  x  29  x  30  mm  and  58  g)  IEEE  1394b  interface 
camera  manufactured  by  Point  Grey  Research.  The  Flea3  incorporates  a  Sony  ICX618  1/4-in 
CCD  image  sensor  that  can  capture  color  video  at  up  to  60  frames  per  second  (fps)  and 
monochrome  video  at  up  to  120  fps.  A  Pentax  C60402KP  C-mount  lens  is  mated  to  the  Plea3's 
interchangeable  lens  mount.  This  lens  is  designed  for  an  effective  focal  length  (EEE)  of  4.2  mm 
when  used  with  a  1/2-in  CCD.  When  the  crop  factor  of  the  smaller  1/4-in  CCD  is  taken  into 
account,  an  EEL  of  approximately  7.5  mm  results  in  a  27  deg  horizontal  field  of  view.  The 
camera  is  attached  to  the  robot  using  a  custom  machined  holder. 
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A  standard  industrial  box  PC  is  used  to  capture  and  process  the  imagery  coming  from  the  Flea3 
over  the  IEEE  1394b  bus.  The  PC  is  an  Advantech  ARK-3420  (ARK)  which  has  a  1.6  GHz 
Corel  Duo  Intel  processor,  4  gigabytes  of  RAM,  and  two  PCI  expansion  slots.  The  PCI 
expansion  slots  are  populated  with  a  dedicated  IEEE  1394b  interface  and  an  Adlink  DAQ-2501 
data  acquisition  card.  Two  of  the  DAQ-2501's  four  available  12-bit  D/A  channels  are  used  to 
produce  voltages  corresponding  to  the  X/Y  coordinates  of  the  target  as  measured  by  the  image 
processing  software. 

Ubuntu  Einux  9.04  (kernel  version  2.6.28)  is  used  as  the  operating  system  on  the  PC.  The 
libdcl394  library  is  used  to  capture  imagery  which  is  streamed  over  the  IEEE  1394b  bus,  and  the 
Adlink  DAQ  is  controlled  with  drivers  provided  by  the  manufacturer. 

Eor  the  purposes  of  this  experiment  the  simplest  possible  imagery  suffices  to  demonstrate  the 
tracking  performance  of  the  robot,  and  for  this  reason  a  method  of  generating  a  controllable  point 
target  is  required.  To  enable  comparison  of  commanded  target  position  and  tracked  target 
position  it  is  desirable  to  simply  control  the  target  with  applied  voltages.  Two  possible  methods 
of  generating  a  target  dot  which  can  be  positioned  using  voltages  are  considered.  Either  system 
can  use  the  same  simple  method  of  target  detection  discussed  below  or  upon  further  investigation 
it  was  decided  that  the  high  price  and  complexity  of  galvanometer  based  systems  was  not 
warranted.  Using  the  oscilloscope  as  a  target  generator  simplifies  many  aspects  of  data  collection 
and  the  fact  that  it  is  a  calibrated  instrument  allows  for  reasonable  confidence  that  the  geometry 
commanded  is  the  geometry  realized  on  the  screen. 

Eor  the  target  type  described  a  simple  method  of  detecting  and  localizing  the  target  is  to  regard 
the  location  of  the  brightest  point  in  the  image  as  the  target  location  and  to  simply  use  the  pixel 
position  of  this  maximum  as  an  estimate  of  the  target  location.  Other  methods  of  target  detection 
such  as  searching  the  image  for  pixels  whose  value  is  above  some  threshold  require  either  strict 
control  of  the  lighting  in  the  laboratory  or  more  complex,  and  therefore  slower,  image  processing 
to  compensate  for  variations  in  the  light  level  of  the  room  and  the  target  intensity. 
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X-Axis  System  ID  and  Fitted  TF  Bode  Plot 


From  approximately  17  Hz  to  33  Hz,  the  plant  modulus  remains  relatively  flat  at  around  1.75  dB. 
After  33  Hz,  the  plant  rolls  off  as  4th  order. 

While  the  modulus  of  the  nominal  plant  model  closely  follows  the  measured  frequency  response, 
the  phase  does  not.  This  phase  discrepancy  has  been  determined  to  be  due  to  a  time  delay  in  the 
sensor. 

Random  noise  generated  by  the  Agilent  VXI  was  displayed  on  the  oscilloscope  target,  and 
SignalCalc  was  used  to  capture  both  this  stimulus  as  well  as  the  sensor's  response.  The  resulting 
data  was  used  to  generate  the  corresponding  frequency  response  graph  to  characterize  the  sensor 
as  shown  in  Figure  29. 


30 

Distribution  A.  Approved  for  public  release;  distribution  unlimited.  88ABW-2012-2229,  13  April  2012 


Sensor  Characterization 
(Bode  Diagram) 
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Figure  29,  Sensor  Frequency  Response  Showing  Linear  Phase  Change  with  Frequency 


The  magnitude  response  of  the  sensor  is  relatively  constant,  while  the  phase  decreases  linearly 
with  frequency  which  indicates  a  time  delay  in  the  camera  system.  There  is  a  measured  phase 
shift  of  180  deg  at  27  Hz,  and  therefore  a  phase  shift  of  360  deg  at  54  Hz.  This  corresponds  to  a 
time  delay  of  18.5  ms,  or  approximately  two  inter-frame  periods  at  110  fps.  This  large  time  delay 
in  the  sensor  is  the  primary  limiting  factor  of  the  controller  bandwidth  and  provides  the 
motivation  for  exploring  the  application  of  the  command  feed-forward  method  to  this  control 
problem. 

4,3,2,  Plant  Identification 

Random  white  noise  over  the  frequency  range,  from  0.01  Hz  to  30  Hz,  of  interest  is  used  to 
stimulate  the  revolute  actuator.  This  stimulus  was  injected  at  four  different  amplitudes,  from  1 
volt  RMS  to  4  volts  RMS,  to  fully  identify  the  response  of  the  Y-Axis.  This  revolute  axis  is 
inherently  nonlinear  as  shown  in  Figure  30.  It  can  be  seen  that  not  only  does  the  modulus  of  the 
response  varies  with  varying  input  amplitudes,  but  there  are  two  poles  that  shift  out  in  frequency 
with  lower  amplitude  input  stimuli. 

The  control  design  procedure  for  the  tracking  system  begins  with  the  design  of  a  SISO  linear 
feedback  controller.  Next  a  command  feed-forward  controller  is  designed  based  only  on  the 
nominal  minimum-phase  plant  model.  Lastly,  an  additional  block  is  designed  in  cascade  with  the 
command  feed-forward  block  to  locally  compensate  for  non-minimum-phase  to  obtain  the  final, 
modified  command  feed-forward  control  system  while  maintaining  the  condition  of  causality. 
The  modified  command  feed-forward  system  is  designed  to  track  an  image  feature  at  frequencies 
below  20  Hz,  while  remaining  stable  with  adequate  gain  and  phase  margins. 
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Frequency  Response  Data  with  Random  Noise  input  0  Hz  -  30  Hz 


Frequency  (Hz) 

Figure  30.  Frequency  Response  of  Y-axis  to  Varying  Amplitude  White  Noise  over 

Frequency  Range  of  Interest 


The  linear  feedbaek  eontroller  for  both  axes  is  limited  to  a  bandwidth  of  2.3  Hz  due  to  the  non- 
minimum-phase  contribution  of  the  camera.  The  design  of  the  linear  feedback  controller  was 
accomplished  by  shaping  the  return  ratio,  T,  where  T=C(s)P(s)  and  C(s)  is  the  controller  and  P(s) 
is  the  experimental  data  obtained  in  the  system  identification.  The  results  of  shaping  of  the  return 
ratio  for  the  X-Axis  can  be  seen  in  Figure  3 1 . 

The  compensator  was  designed  by  placing  poles  and  zeros  in  a  transfer  function  model  of  the 
controller.  This  frequency  response  shaping  results  in  a  6th  order  linear  controller. 
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Loop  Transmission  Plot  for  X-Axis 


Figure  31,  PRRR  Plant  Response  Plot  and  Loop  Transmission 


As  the  Y-Axis  is  inherently  nonlinear,  a  feedbaek  eontroller  is  designed,  using  the  same  classieal 
approach,  around  the  high  amplitude  input  stimulus  response  and  then  stability  is  verified  by 
plotting  the  response  of  the  varying  amplitudes  on  a  Nyquist  plot.  Frequency  shaping  of  the  large 
amplitude  input  results  in  a  5th  order  controller. 

The  result  of  the  feedback  control  design  is  shown  in  Figure  32.  This  Figure  shows  the  loop 
transmission  for  each  varying  amplitude.  To  verify  stability  at  each  case,  the  various  responses 
were  plotted  on  a  Nyquist  plot,  shown  in  Figure  33.  It  can  be  seen  that  the  phase  margin  of  30 
deg  is  maintained  and  the  gain  margin  increases  with  decreasing  magnitude. 
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Imaginary  Axis 


Bode  Diagram  for  Y-Axis  High  Amplitude  Design  (Aggresive) 


Figure  32,  RR  Loop  Transmission  with  Feedback  Controller  Designed  for  the  High 

Amplitude  Input  Stimulus 
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Figure  33,  MIMO  Nyquist  Array  Showing  Diagonal  Dominance 
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After  designing  the  linear  feedbaek  eontrol,  the  assumption  that  the  plant  is  sufficiently 
decoupled  is  verified  by  showing  the  diagonal  dominance  of  the  plant,  justifying  the  design  of 
each  linear  feedback  controller  as  an  independent  SISO  controller.  A  MIMO  Nyquist  array  plot 
of  the  system  is  shown  in  Figure  34.  The  small  magnitude  of  the  off  diagonal  plots  verifies 
diagonal  dominance  of  the  plant,  justifying  the  design  of  each  feedback  as  independent  SISO 
controllers  for  the  two  axes. 


Gershgorin  Analysis  for  X-Axis 


Gershgorin  Analysis  for  Y-Axis 


Real  Axis  Real  Axis 

Figure  34,  Plot  of  Diagonal  Nyquist  Response  Plots  with  Gersgorin  Discs 


4,3.3  Command  Feed-forward  Control  Design 

To  increase  the  effectiveness  of  the  feed- forward  block,  while  having  a  pure  time  delay  in  the 
plant,  the  closed  loop  transfer  function  must  be  broken  into  two  parts.  For  the  case  of  a  minimum 
phase,  proper  plant,  P(s),  the  feed- forward  term,  F_{f},  would  be  an  inversion  of  the  plant. 
However,  in  the  case  of  a  strictly  proper  plant  and  the  presence  of  a  time  delay,  the  feed- forward 
term  is  no  longer  a  simple  inversion.  Additional  poles  are  placed  in  the  feed- forward  block, 
F_{f},  to  make  it  proper.  Previously,  the  plant  model  for  the  PRRR-PR  system  was  shown  to 
have  a  relative  degree  of  four.  Therefore,  four  zeros  were  added  well  beyond  the  bandwidth  of 
the  feedback  controller.  These  zeros  were  all  placed  at  nearly  two  decades  beyond  the 
bandwidth.  The  effects  of  the  time  delay  are  more  difficult  to  overcome. 

Minimizing  the  integral  of  the  absolute  value  of  the  sum  of  the  feed-forward  term,  feedback  term 
and  negative  lover  the  frequency  interval  of  interest  causes  the  closed  loop  response  to  approach 
the  highest  tracking  performance  possible.  Many  variables  go  into  the  development  of  the  closed 
loop  transfer  function,  causing  this  process  of  minimizing  alpha  to  be  done  manually  by  adding 
an  additional  block  in  cascade  to  the  nominal  inverse  plant  model  in  the  feed- forward  path.  The 
additional  block  in  the  feed-forward  path  is  used  to  improve  tracking  response  from  2  Hz  to  20 
Hz,  extending  the  tracking  bandwidth  beyond  that  of  the  linear  feedback  controller  alone  to 
achieve  the  tracking  goal.  Through  several  iterations,  the  closed  loop  response  was  shaped  to 
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maintain  close  to  unity  gain  from  0  Hz  to  20  Hz  while  not  violating  causality.  The  results  are 
shown  in  Figure  35. 


Bode  Diagram  for  X-Axis  Ciosed  Loop  Responses 


Frequency  (Hz) 

Figure  35,  Close  Loop  Response  of  the  X-axis  Showing  Both  Feedback  and  Modified 

Command  Feed-forward  (W) 


A  systematic  approach  is  taken  to  develop  the  modification  of  the  command  feed-forward  path  to 
locally  compensate  for  some  of  the  non-minimum-phase.  This  approach  looks  at  a  finite  band  of 
frequencies  of  interest,  in  this  case  2  Hz  to  20  Hz,  and  adds  an  additional  compensator  block,  call 
it  C_2,  to  the  feed-forward  path.  The  block  diagram  for  this  new  modified  command  feed¬ 
forward  control  is  shown  in  Figure  36.  The  first  step  in  this  design  is  the  placement  of  a  first 
order  lead.  Two  major  considerations  go  into  the  placement  of  the  lead.  First,  the  lead  should  be 
placed  sufficiently  far  from  the  cross  over  frequency  of  the  feedback  system.  Second,  it  is 
important  to  consider  the  amount  of  phase  advance  that  can  be  achieved  based  on  the  bandwidth 
limitations  imposed  by  time  delay.  The  frequency  response  of  the  lead  implemented  is  shown  in 
Figure  37.  The  input-output  frequency  responses  using  standard  command  feed- forward,  and 
modified  feed- forward  with  a  1  decade  and  2  octave  leads  are  shown  in  Figure  38. 
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Figure  36,  Modified  Command  Feed-forward  Block  Diagram  with  Time  Delay 


U2 


Bode  Diagram  of  Command  Feedforward  Modifier  Block 


Figure  37,  Bode  Diagram  for  Modified  Command  Feed-forward  Modifier  Block 
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Bode  Diagram  for  Modified  Command  Feedfoward  Controi 


Frequency  (Hz) 


Figure  38,  Bode  Diagram  for  Modified  Command  Feed-forward  Comparison  of  Addition 

of  Lead  Compensator 


To  start,  consider  a  frequency  separation  of  one  decade  between  the  zero  and  the  pole,  which 
would  provide  about  45  deg  of  phase  advance.  An  example  of  this  lead  is  shown  in  Figure  39 
where  omega  z  is  the  frequency  of  the  zero,  and  omega_p  is  the  frequency  of  the  pole.  For 
tracking,  it  is  desired  to  achieve  a  phase  lag  of  zero,  suggesting  that  the  lead  be  centered  at  the 
frequency  we  expect  to  see  45  deg  of  non-minimum-phase  due  to  the  sensor.  However,  this 
cannot  be  done  as  the  zero  in  this  case  lies  below  the  end  of  the  Bode  Step  designed  in  the 
feedback  control.  The  end  of  the  Bode  Step  is  placed  at  the  frequency  where  there  exists  1  radian 
of  non-minimum-phase,  or  approximately  57  deg.  Placing  the  zero  of  the  lead  below  this  point, 
and  near  the  0  dB  crossover  of  the  feedback  system  can  lead  to  large  gain  errors  as  these  are  the 
frequencies  where  there  is  positive  feedback.  This  means  moving  the  lead  to  greater  frequencies 
to  allow  for  adequate  frequency  separation  from  the  0  dB  cross  over.  The  zero  is  initially  placed 
at  the  end  of  the  Bode  Step.  In  the  case  of  the  plant  presented,  this  would  place  the  zero  at  a 
frequency  of  8.5  Hz  or  greater.  Keeping  as  close  to  the  end  of  the  step  as  possible  allows  for 
greater  phase  advance,  as  the  placement  of  the  pole  will  be  limited  by  the  bandwidth  restriction 
of  the  sensor. 
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The  placement  of  the  pole  depends  on  the  plant  and  the  limitation  presented  by  the  time  delay  of 
the  sensor.  The  greater  the  frequency  separation  of  the  zero  and  pole  leads  to  greater  phase 
advance,  but  will  also  introduce  greater  errors  in  the  modulus  of  the  closed  loop  system.  In 
considering  the  bandwidth  limitations  of  the  sensor  note  that  the  greater  the  delay  the  more 
limited  the  apparent  phase  advance  will  be  as  the  affect  of  a  greater  lead  cannot  be  seen  within 
the  bandwidth.  Less  time  delay  allows  the  tracking  bandwidth  to  be  extended  further,  allowing 
for  greater  phase  advance. 

To  illustrate  the  above  approach  to  placing  the  lead,  consider  the  following  investigation  using 
the  plant  presented  in  this  paper.  Consider  two  cases,  first  the  case  of  a  lead  with  45  deg  of  phase 
advance  or  the  placement  of  the  pole  being  one  decade  beyond  the  zero  and,  secondly,  the  case 
of  approximately  30  deg  of  phase  advance,  or  a  frequency  separation  of  two  octaves  between  the 
zero  and  pole.  These  two  cases  are  shown  in  Figure  40  along  with  the  unmodified  command 
feed-forward  for  comparison.  As  can  be  seen,  there  is  little  difference  between  the  two  in  both 
phase  and  gain,  but  each  is  a  significant  improvement  in  phase  over  the  unmodified  command 
feed-forward  system.  The  negligible  difference  between  the  two  cases  is  due  to  the  bandwidth 
limit.  This  is  small  difference  between  the  two  cases  is  due  to  the  bandwidth  limitation.  As  the 
zero's  of  both  leads  are  located  at  8.5  Hz,  the  center  of  the  leads  vary.  The  greater  advance  from 
the  one  decade  of  separation  lead  is  not  seen  because  the  bandwidth  is  limited  to  the  region 
where  the  phase  advance  of  both  cases  are  close  together.  The  other  important  aspect  to  note  is 
the  increased  gain  error  as  the  phase  error  decreases. 

After  implementing  the  lead  to  locally  compensate  for  phase  error,  a  simple  prefilter  approach  is 
used  to  shape  the  modulus  and  decrease  the  gain  error.  This  modulus  shaping  does  have  some 
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affect  on  the  phase,  but  much  of  the  additional  phase  advance  is  maintained.  Still,  it  is  important 
to  look  at  the  effects  on  both  gain  and  phase  when  shaping  this  modified  command  feed-forward 
control.  This  trade  off  is  directly  seen  in  the  previously  derived  alpha  error  quantity.  The  end  of 
the  design  is  an  iterative  approach.  After  the  above  basic  guidelines  for  placement,  small  changes 
are  made  to  the  lead  and  filters  to  achieve  the  smallest  alpha  quantity  as  possible  by  hand. 

For  the  plant  presented,  the  final  design  for  this  new  block,  C_2,  includes  a  lead,  with  a  zero  at  9 
Hz  and  a  pole  at  1 8  Hz,  to  locally  compensate  for  some  of  the  non-minimum-phase  and  a  sixth 
order  combination  of  notch  filters. 


X-Axis  Error  Quantification  using  Norm  of  N(jw) 


Frequency  (Hz) 
Figure  40,  Plot  of  |N| 


Additionally,  the  values  for  N(jw)  are  plotted  in  Figure  40  to  show  the  effects  of  the  modified 
command  feed-forward  controller. 

By  integrating  the  norm  of  the  N(jw)  function  over  the  desired  tracking  bandwidth  of  0  Hz  to  20 
Hz,  we  obtain  a  value  for  alpha  for  both  the  feedback  and  modified  command  feed-forward 
systems.  The  feed-forward  has  an  error  value  of  1 1.25  while  the  modified  command  feed¬ 
forward  has  an  error  value  of  1.53.  Thus  the  addition  of  the  modified  command  feed-forward 
controller  provides  7.35  times  the  performance  of  the  feedback  control  alone. 

Several  time  domain  tests  were  completed  to  compare  the  closed  loop  tracking  performance  of 
both  the  linear  feedback  control  system  and  the  modified  command  feed-forward  control  system. 
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Two  different  reference  signals  are  used  for  these  tests:  an  internally  generated  continuous  sine 
reference  and  an  externally  generated  discontinuous  triangle  reference.  The  first  reference 
trajectory  for  testing  the  tracking  performance  is  a  sine  reference  signal  generated  discretely  on 
the  NI  machine.  The  program  provides  the  ability  to  vary  the  amplitude,  frequency  and  phase  of 
the  reference  sine.  The  performance  was  tested  at  three  different  frequencies  to  verify 
performance.  The  results  of  these  tests  are  shown  in  Figure  41.  Similarly,  the  tracking 
performance  of  a  discontinuous  reference  signal  was  tested.  This  reference  trajectory  consists  of 
an  externally  generated  triangle  wave  provided  by  an  Agilent  33120  Function  Generator  input 
into  the  NI  machine.  The  function  generator  provides  the  ability  to  vary  the  amplitude  and 
frequency  of  the  reference  signal.  The  discontinuous  tracking  performance  was  tested  at  three 
varying  frequencies,  0.5  Flz,  3  Hz,  and  12  Hz.  These  results  can  be  seen  in  Figure  42.  These 
closed  loop  results  verify  the  improvement  of  the  target  tracking,  the  extension  of  the  tracking 
bandwidth  out  to  20  Hz,  and  the  ability  to  track  discontinuous  reference  signals  by  implementing 
the  modified  command  feed-forward  control. 


Input/Ouput  time  data  for  sine  reference  @  0.5  Hz 


Figure  41,  Tracking  Performance  with  Input  Sine  Reference  at  Various  Frequencies 
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Amplitude  Amplitude  Amplitude 


Input/Ouput  time  data  for  triangle  reference  @  0.5  Hz 


Figure  42,  Tracking  Performance  with  Input  Triangle  Reference  at  Various  Frequencies 
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5.  CONCLUSIONS 


Tracking  systems  used  on  military  unmanned  ground  vehieles  must  be  lightweight,  rugged  and 
have  very  high  performanee.  Commereial,  off-the-shelf  artieulation  systems  are  too  fragile,  and 
eommon  eontrol  teehniques  (e.g.  proportional-integral-derivative)  have  insufheient  performanee. 
To  provide  solutions  to  this  ehahenging  problem,  novel  PKM  arehiteetures  and  eontrol 
approaehes  have  been  developed  for  high  performanee  disturbanee  rejection  and  target  tracking 
related  speeiheahy  to  Air  Foree  unmanned  ground  vehiele  systems.  The  RR-PUS  and  RR-PRRR 
(“Prismatie/revolute  orienting  apparatus,”  US  Patent  applieation  No.  13,099,299,  May  2011)  two 
DOF  PKMs,  developed  at  the  University  of  Wyoming,  are  stiff,  rugged  and  fast  artieulation 
systems  that  are  easily  manufactured.  Extremely  aggressive  control  systems  have  been  designed 
providing  very  large  disturbance  rejection  and  tracking  accuracy.  Nonlinear  feedbaek  eontrol  has 
been  sueeessfuhy  implemented  on  this  hardware  allowing  for  maximum  feedbaek  and  stability 
despite  the  presenee  of  nonlinearities  in  the  feedback  loop.  This  type  of  eontrol  has  been 
implemented  only  on  a  small  number  of  real  systems.  A  new  modihcation  of  eommand  feed¬ 
forward  eontrol  has  been  sueeessfuhy  implemented  on  these  PKMs  that  provides  high 
performanee  traeking  despite  signifieant  non-minimum  phase  delay  due  to  traeking  eamera  time 
delay.  The  combination  of  these  new  PKMs  and  advaneed  eontrol  methods  is  a  substantial  new 
Air  Force  capability  for  future  unmanned  ground  vehiele  applieations. 
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LIST  OF  SYMBOLS,  ABBREVIATIONS,  AND  ACRONYMS 


AC 

alternating  current 

arg 

argument 

ASFG 

absolutely  stable  fixed  gain 

C  X 

eompensator  x 

CCD 

eharged-eoupled  deviee 

cm 

eenti-meters 

COTS 

eommereial  of  the  shelf 

D/A 

digital  to  analog 

dB 

deeibels 

DC 

direet  current 

deg 

degrees 

DF 

deseribing  funetion 

DOF 

degree  of  freedom 

EFL 

effeetive  foeal  length 

F 

feed-forward  system 

fps 

frames  per  seeond 

HeNe 

helium  neon 

Hz 

Hertz 

HR 

infinite  impulse  response 

k  Hz 

kilo-Hertz 

MIMO 

multiple  input,  multiple  output 

mm 

millimeters 

ms 

milli-seeonds 

mV 

milli-volts 

N 

Newtons 

N(j  omega) 

feed-forward  performanee  funetion 

NEMA 

national  eleetrieal  manufaetures  assoeiation 

P  X 

plant  X 

PKM 

parallel  kinematie  maehine 

PRRR-RR 

prismatie  revolute  revolute  revolute-revolute  revolute 

PSD 

position  sensitive  deteetor 

PUS-RR 

prismatic  universal  spherieal-revolute  revolute 

PZK 

pole  zero  gain  (K) 

Q 

quality  faetor 

rad 

radians 

rms 

root  mean  square 

s 

seeonds 

S  X 

sensitivity  x 

SISO 

single  input,  single  output 

T_x 

loop  transmission  x 

t  sat 

saturation  threshold 

V 

volts 
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